10/500372 

1/9 

FIG. 1 




OBLOHErALC7(»)«3«a> 

^0/500372 

2/9 



FIG. 2 




OBLON ET AL (703) 413-3000 



iO/500372 



r3A 



MOTION 
REQUEST 
INPUT UNIT 



CRURAL 
MOTION 
PARAMETER 



CENTER-OF- 

GRAVITY 

VERTICAL 

POSITION 

BASIC 

MOTION 



MAIN BODY 
ORIENTATION 
BASIC 
MOTION 



UPPER-BODY 
JOINT ANGLE 
REFERENCE 
MOTION 



34 



UPPER-BODY 

JOINT ANGLE 

REFERENCE 

TRAJECTORY 

INTERPOLATION 

UNIT 



3/9 



SOLE 

POSITION/ 

ORIENTATION 

TRAJECTORY 

GENERATING 

UNIT 



31 



SOLE 

POSITION/ 

ORIENTATION 

REFERENCE 

MOTION 



CENTER-OF- 

GRAVITY 

POSITION 

TRAJECTORY 

GENERATING 

UNIT 



32 



CENTER-OF- 

GRAVITY 

POSITION 

REFERENCE 

MOTION 



MAIN BODY 

ORIENTATION 

TRAJECTORY 

GENERATING 

UNIT 



33 



35- 



MAIN BODY 
ORIENTATION 
REFERENCE 
MOTION 



MAIN BODY 

ORIENTATION 

REFERENCE 

TRAJECTORY 

INTERPOLATION 

UNIT 



r- -3B 



FIG. 3 



REAL TIME WHOLE BODY 
MOTION GENERATING UNIT 



36 



CENTER-OF- 

GRAVITY 

POSITION 

REFERENCE 

TRAJECTORY 

INTERPOLATION 

UNIT 



MAIN BODY 
ORIENTATION 
ANGLE 



POSITION OF 
CENTER OF 
GRAVITY 



37 



SOLE 
POSITION/ 
ORIENTATION 
REFERENCE 
TRAJECTORY 
INTER- 
POLATION 
UNIT 



SOLE 

POSITIONS/ 
ORIENTATIONS/ 



MASS POINT 
DISTRIBUTION 
ADJUSTING 
UNIT 



JOINT ANGLE 
CALCULATING 
UNIT 



JOINT ANGLES 
OF WHOLE 
BODY 



WHOLE-BODY 
JOINT ANGLE 
DRIVING UNIT 



3C 



OBLON ET AL (703) 413-3CX)0 



10/5003 



4/9 

FIG. 4 



GENERATION OF MOTION 
I OF WHOLE BODY 













> 


r 




INPUT MOTION 


. REQUESTS 


SI 


> 


f 




GENERATE SOLE POSITION/ORIENTATION 

TRAJECTORIES 


Oil 


> 


r 




GENERATE CENTER-OF-GRAVITY POSITION 
TRAJECTORY 


S3 




r 




GENERATE MAIN BODY ORIENTATION TRAJECTORY 


S4 


> 


f 




PERFORM TRAJECTORY INTERPOLATIONS 


S5 


> 


f 




ADJUST MASS POINT DISTRIBUTION 


S6 


> 


f 




DRIVE JOINTS OF WHOLE BODY 


S7 










f 



At 



( END ) 



OBLONETAL (703) 413^3000 



5/9 

FIG. 5 



POSITION 0(R2,Yr2,Zr2) 
ORIENTATION (QfR2,jS R2.r R2) 
POSITION (Xl2,Yl2,Zl2) 
ORIENTATION (aL2,0 Lz.r^-z) 





<!>-4 




SUPPORT 
BY BOTH 
LEGS 



SUPPORT 
BY BOTH 
LEGS 



SUPPORT 
BY BOTH 
LEGS 



POSITION (XRi.Ybi.ZRi) 
ORIENTATION (of Ri.yS Ri.r Ri) 
POSITION (Xli,VLi.Zli) 
ORIENTATION (OTLi.iS Li,r li) 



SUPPORT 
BY ONE 
LEG 



SUPPORT 
BY ONE 
LEG 



FIG. 6 




OBLON ET SL (703) 413-3000 

nrx-igPT mZ.9YM^S shkbt ^ r>p *f 



107500372 



6/9 



FIG. 7 



FLOOR 

CONTACT 

PERIOD 



FLOOR FLOOR 
NON-CONTACT NON-CONTACT 

FLOOR P^^*^ FLOOR 
\ CONTACT V CONTACT 

; PERIOD ; PERIOD 

^ — ^ ' 



FLOOR 

CONTACT 

PERIOD 




FIG. 8 



Z4 



FLOOR 

NON-CONTACT 
PERIOD 



FLOOR 

CONTACT 

PERIOD 



FLOOR 

NON-CONTACT 
PERIOD 



FLOOR 

CONTACT 

PERIOD 



FLOOR 

CONTACT 

PERIOD 




INTERVAL 
.1-2 



INTERVAL 

i-1 



INTERVAL 

. = J '- 



INTERVAL 



INTERVAL 

i+2 



CENTER-OF-GRAVITY 

VERTICAL POSITION 

BASIC TRAJECTORY 
I 
I 



CENTER-OF-GRAVITY 
VERTICAL POSITION 
REFERENCE 
TRAJECTORY 



TIME 



OBLONBTAL (709) 413-3000 

DOCKET ft226^iS^*HEEr_2.0F_2_ 

iO/500372 

7/9 



FIG. 9 



SOLE 

POSITION/ 

ORIENTATION 

TRAJECTORIES 



C 



GENERATION OF CENTER- 
OF-GRAVITY TRAJECTORY 



CENTER-OF- 
GRAVITY 
HEIGHT 
BASIC 

TRAJECTORY 



3 



GENERATE ZMP BASIC NODE 
ARRANGEMENT 



SET CENTER-OF-GRAVITY 
TRAJECTORY CONTINUITY 
CONDITIONS AT BOUNDARY 
OF SHORT INTERVALS 



SET BOUNDARY CONDITIONS OF 
CENTER-OF-GRAVITY HORIZONTAL 
TRAJECTORY AT STARTING END/ 
TERMINATION END 



CALCULATE CENTER-OF-GRAVITY 
HORIZONTAL TRAJECTORY 
(QUADRADIC PROGRAMMING 
WITH EQUALITY CONSTRAINTS) 



CALCULATE NON-CONTACT 
PERIOD CENTER-OF-GRAVITY 
VERTICAL TRAJECTORY 
(FREE FALL CURVE) 



S11 



S12 



S13 



S14 



CENTER-OF- 
GRAVITY 
HORIZONTAL 
POSITION - 
TRAJECTORY 



SI 5 



CALCULATE CENTER-OF-GRAVITY 
VERTICAL POSITION/SPEED AT 
BOUNDARY OF SHORT INTERVALS 



CORRECT CONTACT PERIOD 
CENTER-OF-GRAVITY VERTICAL 
POSITION TRAJECTORY 



S16 



S17 



C END ^ 



CENTER-OF- 
GRAVITY 
VERTICAL 
POSITION 
TRAJECTORY! 



OBLOHETAL (703) 413-3000 



10/5003 7a 

8/9 



FIG. 10 



FLOOR 

CONTACT 

PERIOD 



FLOOR 

CONTACT 

PERIOD 



FLOOR 

CONTACT 

PERIOD 



FLOOR 

NON-CONTACT 
PERIOD 



FLOOR / 
NON-CONTACT \ 
PERIOD ) 

^ 



{NUMERICAL 
J INTEGRATION 


i> NUMERICAL 
}: INTEGRATION 




-6- 










[tNTEfiVAL^ INTERVAL 


i INTERm i INTERVAL 


INTERVAL 


ImAIN BODY 
1 ORIENTATION 

I BASIC 

I TRAJECTORY 


[ J^2 '\ i-1 


[ ' i i"*"^ 


1 i+2 


! MAIN BODY 
! ORIENTATION 

! REFERENCE 
1 TRAJECTORY 








! TIME ^ 



OBLON £T AL (703) 41343000 
DOCKETI 



10/500372 



GENERATION OF MAIN 
BODY ORIENTATION 
TRAJECTORY 



9/9 




FIG. 11 



S22 



FLOOR NON- 
CONTACT PERIOD?' 

YES 



/SOLE 
POSITION/ 

' ORIENTATION/ 
TRAJEC- 
TORIES 



S23 



DETERMINE 

JACOBIAN 

REGARDING 

CURRENT 

SOLE 

POSITIONS 



CENTER- 
OF- 

GRAVITY 

TRAJEC- 
TORY^^ 



DETERMINE 

JACOBIAN 

REGARDING 

CURRENT 

POSITION 

OF CENTER- 

OF-GRAVITY 



S24 



ANGULAR] 
MOMEN- 
TUM 



DETERMINE 

JACOBIAN 

REGARDING 

CURRENT 

ANGULAR 

MOMENTUM 



S25 



CALCULATE 
ANGULAR 
SPEED FOR 
CURRENT 
BASIC 

ORIENTATION 
(SIMULTANEOUS 

LINEAR 

EQUATIONS) 



S26 



PERFORM 
NUMERICAL h 
INTEGRATION 



'MAIN BODY 
ORIENTATION 
TRAJECTORY 
AT FLOOR 
NON-CONTACT 
PERIOD 



STARTING END OF 
FLOOR ^CONTACT PERIOD?" 

S27 

ADJACENT TO FLOOR 
NON-CONTACT PERIOD?- 




NO 



NO 



S28 

FLOOR'NON-CONTACT PERIOD 
IMMEDIATELY FOLLOWS?. 



SET ANGULAR MOMENTUM AT 
FLOOR NON-CONTACT START TIME 



S29 



DETERMINE JACOBIAN 
REGARDING SOLE 
POSITIONS AT FLOOR 
NON-CONTACT START TIME 



c-jO/MAIN BODY 
ORIENTATION 
BASIC 

TRAJECTORY 



DETERMINE JACOBIAN 
REGARDING CENTER-OF- 
GRAVITY POSITION AT 
FLOOR NON-CONTACT 
START TIME 



S31 



DETERMINE JACOBIAN 
REGARDING ANGULAR 
MOTION AT FLOOR 
NON-CONTACT START TIME 



S32 



S33 



CALCULATE MAIN BODY ORIENTA- 
TION ANGULAR SPEED AT FLOOR 
NON-CONTACT START TIME 
(SIMULTANEOUS LINEAR EQUATIONS) 



FLOOR NON-CONTACT ^34 

PERIOD IMMEDIATELY . 

PRECEDING? ^-^"^ NO 




S37 ^ 



CALCULATE 
MAIN BODY 
ORIENTATION 
ANGULAR 
SPEED 
AT FLOOR 
CONTACT 
PERIOD 
TERMINA- 
TION END 



S38 



CALCULATE 
MAIN BODY 
ORIENTATION 
ANGULAR 
SPEED AT 
FLOOR 
CONTACT 
PERIOD 
STARTING 
END 



OBTAIN ORIENTATION ANGULAR SPEED 
AT FLOOR CONTACT START TIME 



S39 



T 



CORRECT MAIN BODY ORIENTA- 
TION TRAJECTORY AT FLOOR 
CONTACT PERIOD (POLYNOMIAL 
INTERPOLATION. ETC.) 



i S36 



SET MAIN BODY 
ORIENTATION 
TRAJECTORY AT 
FLOOR CONTACT 
PERIOD 



C END ) [_ 



MAIN BODY ORIENTATION TRAJECTORY 
AT FLOOR CONTACT PERIOD 



7 



